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1 Introduction 

Robot* working in * perfectly structured world do not 
need *en*ing: a structured world in which the dimensions 
of all parts are within tolerance and in which careful plan- 
ning has taken place to ensure that such parts can be 
assembled, a world in which everything is precisely lo- 
cated and everything functions as planned, a world in 
which all necessary jigs[l| have been designed and pro- 
vided. Such a world is the production engineer's dream 
and will probably never exist. Even in today’s most au- 
tomated and structured factories there are still operators 
present to "un-jam" the perfect machines when the struc- 
ture gets a little out of line. These machines, which we call 
robots, are of course only programmable universal transfer 
device*, machines which can be programmed to move tire- 
lessly from position to position as perfectly as the parts 
and machines they work with. Real robots don’t belong 
in factories any more than people do; what is needed in 
factories is well designed automation tended by operators. 

Of course there is a limit to the number of well de- 
signed pieces of automation we can have. In the home, 
for instance, a sewing machine and a food-processor do 
their jobs much better than humans(l), but the modern 
kitchen is slowly beginning to fill up with such special 
purpose devices, which the displaced humans now spend 
their “leisure" time fixing. Humans are needed to provide 
the structure required by these devices. The dish-washer 
functions well In ; ts own environment^], but who puts the 
dishes in and takes them out? Further, the automation 
of many tasks such as dishwashing requires the substitu- 
tion of massive quantities of energy and natural resources 
(The Regular Cycle uses 20 gallons of water which must 
be heated to at least 180*) in place of intelligence (“That 
plate’s o.k./he didn't use it, just brush off the crumbs,"). 


When any lack of structure occurs, however, we must 
rely on sensors. If something is misplaced, or if something 
will not fit, relying on a sensor-less, geometry controlled 
approach would be a disaster. Sensors have two roles, to 
monitor task execution and to establish the state of the 
world. Both these tasks require the use of a world model. 
Both tasks also require reasoning and planning. Estab- 
lishing the state of the world require* a tensor strategy 
and the interpretation of sensor data in terms of the world 
model. Monitoring task execution also require* sensor 
strategies and interpretation of sensor readings in terms 
of the world model. Errors, when they occur, are detected 
by the interpretation of sensor data, once again in terms 
of the world model. If this is to be done reliably a number 
of independent sensors is needed (sensors fail also). Once 
an error state ia determined, appropriate recovery action 
must be planned. If a part is dropped on the floor, then 
it may be left, but if it is dropped inside a mechanism 
where it could prevent functioning, then it must either be 
retrieved or the mechanism replaced. Error recovery is 
not simple. 

Of all the sensors that a robot might have, forte sens- 
ing is the most fundamental. Blind people function quite 
well in the world 6ut people who have no kinesthetic feed- 
back are totally helpless. Consider the well structured 
world of manufacturing with a task fully under position 
control: the detection of any unexpected force is a clear 
indication that something has gone wrong. Force sensing 
can provide this vital information. In any situation where 
complete structure is absent, force sensing becomes pri- 
mary in the sequencing of a task. Consider teleoperation 
where tasks have some structure^]. 


/This material ia baaed oa work supported by the National Science 
Foundation under Grant No. DMC-34 11879. Any opinions, finding!, 
and conclusions or recommendations expressed in this publication are 
thpee of the authors and do not necessarily reflect the views of the 
National Science Foundation. 
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The general-purpose manipulator may be used 
for moving object#, moving lever* and knob#, 
aaeembling part#, and manipulating wrenche*. 

In all these operation# the manipulator must 
come into physical contact with the object be- 
fore the desired force and movement can be 
mad* on it. A collision occurs when the ma- 
nipulator makes this contact. General-purpose 
manipulation consists essentially of a series of 
collisions with unwanted forces, the applica- 
tion of wanted forces, and the application of 
desired motions. The collision forces should 
be low, and any other unwanted forces should 
also be small. 

Goertx identifies three clear states: 

1. Motion in free space. 

3. The exertion of a force. 

This work of Goerts influenced the use of force se- 
quencing in the manipulator control system WAVE(3] and 
later that of Inoue[4j. Two types of commands were in- 
cluded in a language WAVE describing a sequence of ma- 
nipulator motions. 

STOP terminate the current motion when a force equal 
to the argument is detected, also known as a ‘guard- 
ed move"(5|. 

FORCE during the next motion, the force in a give-; 
direction, is to be controlled to the value given as 
an argument. If the force is specified to be zero then 
the manipulator is “free" to move in the direction 
specified. 

A further command allowed for a force to be applied by 
the manipulator, of course, the manipulator would have 
to be free in the direction In the “Force Vector Assembler 
Concept [6|" commanded manipulator Cartesian veloc- 
ities could be modified by measured end-effector forces 
and moments 

v = vo - [MJ f (1) 

Off-diagonal elements of the matrix M allowed for mo- 
tion to be specified in directions orthogonal to an appiied 
force. A curious side effect of this produced a switching 
phenomenon similar to that described above — a contin- 
uous control system with two states. The end effector 
would trace along an edge until a corner was reached and 
then proceed to trace along the next edge. Unfortunately 
it was not possible to continue in this fashion along the 
following edge. A similar “switching" phenomenon oc- 
curs in a special device for making chamfer-less insertions. 
The pin is brought into the hole at an angle, on contact a 
linkage rotates the pin to align it with the hole axis where- 
upon insertion occurs. These phenomena axe, however, 
limited to only two states and do not generalize further. 
Recently this type of control has formed the basis of more 
complex insertion strategies [7] in the form of a ‘general- 
ized damper* in which the force expected is proportional 
to the velocity error along some direction. Both of these 
strategies are limited to two-state systems. A task to in- 
sert a key into a lock, turn the lock 180 degrees, and then 


withdraw the key, cannot be characterized by such a con- 
tinuous system. It is, however, simple to describe such a 
task in terms of force /displacement transitions and con- 
trol mode switches such as used in WAVE [8]. 

We may then characterize manipulator control into 
two basic states and transitions between them: 

• When a manipulator is moving in free space it con- 
trols displacement and monitors force. The detec- 
tion of any unpredlcted forces indicates a serious 
error state. 

• When a manipulator is constrained by the environ- 
ment it controls force and monitors displacement. 
The detection of any unpredicted displacement in- 
dicates a serious error. 

• On contact, or on breaking contact, the control and 
monitoring modes switch. As contact is made the 
reaction forces rise, indicating contact. When the 
desired contact force is obtained the control mode 
switches from displacement control to force control 
and the contact force is maintained at the required 
value. As contact is broken the reaction forces go to 
zero and the control mode switches to displacement 
control with the contact force maintained at zero. 

The detection of contact is a problem for a rigid ma- 
nipulator of finite inertia. When contact is detected the 
manipulator is brought to rest diacontinuously — it is 
stopped. The kinetic energy is dissipated by various mech- 
anisms, some potentially destructive. Given the stiffness 
of the manipulator and of the environment there is a 
clearly defined maximum speed at which contact may be 
safely detected and controlled. 

2 Force and Position Controlled 
Degrees of Freedom 

When a manipulator is constrained by the environment, 
force is controlled. There are, however, six environment 
constraints, three of translation and three of rotation. For 
each of these six degreee-of-freedom either force control or 
position control may be specified[3|. 

A robot manipulator closing a door by grasping the 
handle firmly has only one degree of rotational freedom 
— the rotation of the door about the hinge axis. In this 
situation force control is required along all three trans- 
lation axes and force control is required about the two 
rotation axes perpendicular to the hinge axis. Rotational 
position control is required about the hinge axis. Note 
that one doesn’t simply push on the door handle to close 
the door but one controls the angle of closing as a function 
of time — how fast the door is closed — “Don’t slam the 
door!" All the remaining axes are in a control mode 
with a desired force of zero along and about all other 
axes. Notice also in the above example that the forces 
and displacement control modes may be simply described 
in some orthogonal coordinate frame. In the example 
given, the origin of the c jordinate frame would be along 
the hinge axis with one of the axes aligned with the hinge 
axis. If the z axis were aligned with the hinge axis then 
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we could specify the compliance needed w ehown in Fig- 
ure 1. Notice the motion request ROTATE end the motion 
WITH 


FORCE 

X - 0. 

FORCE 

T - 0. 

FORCE 

Z - 0, 

TORQUE 

X - 0. 

TORQUE 

r • o 

ROTATE 

ABOUT Z 


UNTIL 

TORQUE Z - 100; 

Figure 1: A Program to Cioee a Door 

termination specification UNTIL TORQUE Z • 100. 

Manipulators are controlled by actuators located at 
their joints. To provide for the control of the six Cartesian 
environment variables, position and rotation, six joints 
are required. It a degree of freedom of the manipulator 
is constrained then attempting to control all six joints 
will result in an over-constrained system; large internal 
forces can result. If one of the joints which contributes to 
motion in the constrained direction or axis is controlled 
in force in place of displacement, the overconstraint dis- 
appears and the system is controllable. This approach 
was first used by Inoue in turning a crank(9] and later 
formed the basis of the compliance used in WAVE(3|. If 
more than one degree-of-frccdom of constraint exists then 
additional joints must be force controlled to provide for 
each constraint. In the door closing example given above, 
five joints of a six-degree-of-frccdom manipulator would 
be force controlled at zero force, and one joint, whose 
principal motion was in the door closing direction, would 
be displacement controlled. 

If the motion of the joint selected to provide a degrec- 
of-freedom does not correspond completely with the con- 
strained direction then the the position of the manip- 
ulator will be modified in the unconstrained directions 
In turning the crank, the crank would be either slightly 
ahead or behind its correct position. If this matters it 
may be compensated for by modifying the commanded 
Cartesian position[lO,ll|. The major problem with com- 
pliance provided in this manner is in selecting the appro- 
priate joints to provide the compliance. While it is always 
obvious which joints should be controlled in any given sit- 
uation, there is as yet no formal algorithm to select these 
joints automatically. Another drawback is that in cer- 
tain motions the joint to provide the compliance changes 
as the motion is made. Consider turning a crank: with 
the crank at the top of its motion, a joint which controls 
vertical motion would be appropriate to provide the nec- 
essary radial compliance, but as the crank is turned the 
radial direction requires a joint which controls horizontal 
motion. Switching between joints can be done(3j but it is 
difficult. 

This form of compliance is very simple to implement in 
manipulators whose actuators are powered by electric mo- 
tors as motor current is directly proportional to torque[3|. 
Joint friction and gearing, however, detract from this sim- 
ple form of control and various attempts have been made 
to close a torque control loop around the joint [ 1 2]. These 


methods have met with only moderate success as the con- 
trol coupled two rigid systems of comparable frequency 
response) 13). 

In 1981 Raibert and Craig developed a control method 
called “Hybrid Position/Force Control) H]," based on the 
theoretical formulation of the above compliance methods 
by Mason[lS). In this method not only was the com- 
pliance specified in an appropriate Cartesian coordinate 
frame but the control separation between position and 
force was also performed in Cartesian coordinates. The 
observed joint position of the manipulator was converted 
into Cartesian coordinates and subtracted from the de- 
sired Cartesian coordinate poeition yielding Cartesian po- 
sition errors. Any position errors in a complying or force 
control direction were then set to zero and the remaining 
errors were transformed back into joint coordinates us- 
ing the Jacobian inverse. These errors were then fed to a 
PID controller to reduce errors In position controlled di- 
rections to zero. Note that no position feedback is applied 
in any complying direction. Similarly, force errors were 
compared to the desi.ed force to yield force errors in the 
Cartesian control frame. Any errors in a nor.-compliant 
or position controlled direction were then set to zero be- 
fore these force errors were transformed into joint torque 
errors by the Jacobian transpose. Note that no forces 
were specified in any position controlled direction. In the 
system implemented by Raibert and Craig) M] a force and 
torque sensor was mounted at the wrist of the manipula- 
tor to provide feedback for the force loop. Stabilization 
of the force loop was, however, marginal with resort to ad 
hoc control methods necessary. Once again we have two 
rigid systems of comparable frequency response, the ma- 
nipulator and the force sensor, such a system is very diffi- 
cult to stabilize |l3l. A similar system making use of the 
relationship between motor currents and joint torques has 
also been implementcd|l 1). This system, with open-loop 
torque control, docs not suffer from the stability problems 
but does suffer from frictional and gearing disturbances. 

In 1983, Khatib, at Stanford University went one step 
farther and resolved the manipulator joint inertias into ef- 
fective Cartesian Inertias seen from the end-effector of the 
manipulator) 16]. Once Cartesian position errors were de- 
tected, using the hybrid position/force control scheme, a 
PID controller was implemented in Cartesian end-effector 
coordinates to produce corrective accelerations which were 
then transformed into corrective forces by the effective 
Cartesian inertias. The resulting forces were transformed 
into joint torques in order to control the manipulator, 
again using the Jacobian transpose relationship between 
forces and joint torques. Unfortunately, as the manipula- 
tor configuration changes, the rate of change of effective 
Cartesian joint inertia varies much more rapidly than does 
the corresponding joint inertias. This is a considerable 
computational burden. A second problem is that feed- 
back gains are applied in Cartesian coordinates while the 
manipulator is actuated in joint coordinates, and while 
it is possible to set constant hign gains in joint coordi- 
nates it is not clear if similarly high gains are possible in 
Cartesian coordinates. No comparison between control 
methods for the same manipulator has been made. 
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3 Stability 

In the previous Section we described the hybrid control 
of position and force. This represent the two states de- 
scribed by Goertxj2j. In this Section we will consider the 
stability of these two modes and the problems of transi- 
tions between them. In the position control of manipula- 
tors high stiffness is desired so that the manipulator will 
be unaffected by disturbances. We would like the manip- 
ulator to move swiftly from position to position, stopping 
as quickly as possible with no overshoot. When the ma- 
nipulator is begin controlled at some position, we would 
like it to be unaffected by the application or any external 
forces of moments. It should act like a very stiff damped 
spring, very hard to deflect and dead-teat in its response 
to external disturbances. This is achieved by the applica- 
tion of feedback. Position feedback is required to provide 
stiffness, velocity feedback to provide damping, and inte- 
gral feedback to provide for the removal of any bias forces. 
Feedback gains are limited by the stiffness of the manip- 
ulator itself. The setting of gains and the design of a ma- 
nipulator for a given stiffness are a difficult engineering 
problems. The result is a system which has a well behaved 
basic response with a number of high frequency modes 
which decay slowly when excited. Such systems behave 
adequately in position mode but perform poorly in force 
control. The force sensor and environment are, unfortu- 
nately, both systems with natural frequency responses of 
the same order of magnitude as that of the manipulator. 
When these are coupled by contact of the manipulator 
with the environment then the resulting system is very 
difficult, if not impossible, to stabilize [ 17,13,18,19,12.14). 
Whitney and Fppinger in their papers both indicate that 
stability may only be obtained when the sensor is stiff and 
the environment soft or when the sensor is soft and the 
environment stiff. Unfortunately, a soft sensor completely 
negates the stiffness required for position control. 

The remaining problem is the implementation of the 
transitions between position and force control. This oc- 
curs when the manipulator makes contact with the en- 
vironment. Contact between a rigid manipulator and a 
rigid environment is not well defined — the manipulator is 
moving at some velocity and then it is stopped. Where 
does the energy go? It is absorbed by the compliances 
in the system and, hopefully, dissipated. This can be 
destructive of many mechanical components such as, pre- 
cision gears, shafts, actuators, etc. To run any commer- 
cially available robot into a brick wall would result in con- 
siderable damage! The use of any form of force sensing 
aggravates this problem as the force sensor is typically the 
least stiff member of the system, the most fragile, and ab- 
sorbs all the energy. The design problem of Scheinman's 
“Maltese Crass" wrist force sensor was not the sensor it- 
self but the force overload mechanism needed to protect 
it from damage. No form of force sensor based feedback 
changes this problem as the time constant of the inter- 
action i3 much shorter than that of the regulator. On 


contact, tha force sensor sees a rapidly increasing fore* 
and the sensor output goee immediately off-ecale. The 
time scale of title Interaction la of the order of a few mi- 
croseconds. This eigne) ia processed by a regulator which 
has a well defined minimum time response of the order of 
milliseconds. Contact is long since over before the regu- 
lator can respond and any damage to occur has already 
occurred. The contact problem ia unsolved for rigid ma- 
nipulator, rigid senior, rigid environment problems. 

4 Mechanical Compliance 

Based on a careful analysis of a peg-in-hole insertion [20] 
and the force-vector steering method (6j, a mechanical 
implementation of an insertion algorithm was developed 
at Draper Laboratories, the "remote center compliance 
— RCC" [21]. This device provided the necessary com- 
pliance to make peg insertions into low clearance holes 
from a vertical direction. The compliance waa provided 
passively by springs. 1 

In the initial version of the remote center compliance 
no displacement sensing waa provided, making the device 
very susceptible to damage if the displacement capacity 
of the device was exceeded. However, a later version, “the 
Instrumented Remote Center Compliance — IRCC" also 
provided displacement sensing which could be monitored 
to prevent damage. Both devices could be locked for po- 
sition control to provide the two necessary control modes. 
The device waa low inertia with high bandwidth so that 
contact could be made at high speed by the manipulator 
with the small energy of contact (due to the low inertia of 
the RCC) absorbed by the passive compliance. The use of 
passive compliance solves the contact problem 1 although 
the device must be locked to provide for position control 
and the stiffness k is defined mechanically and may not 
be programmed. 

In order to overcome the locking problem Roberts[23 
investigated an instrumented single compliant link. The 
displacement of the link was used to stiffen the link for 
position control and to soften the link for force control. In 
the position control mode any displacement of the end of 
the terminal link caused the manipulator to move in the 
opposite direction so as to restore the initial position. In 
the force control mode any displacement of the terminal 
link would cause the manipulator to move so as to restore 
the initial displacement. Contact could be detected by the 
deflection of the terminal link and the resuiting motion, 
while the manipulator was brought to rest, absorbed by 
the compliant link as in the IRCC. It was shown that 
both modes were stable. We are currently working on a 
six-degree-of-freedom version of the device and hope to 
show stability and function. 


‘Hanafusa and Asads made use of a spring losdsd band to pro- 
vide compliance between the workpiece, the manipslator, and the 
environment but did not directly address the contact problem. 22|. 


258 


5 exclusions 

The hybrid control of force and position is basic to the 
science of robotics but is only poorly understood. Be- 
fore much progress can be made in robotics, this problem 
needs to be solved in a robust manner. However, the use 
of hybrid control implies the existence of a model of the 
environment, not an exact model (as the function of hy- 
brid control is to accommodate these errors), but a model 
appropriate for planning and reasoning. The monitored 
forces in position control are interpreted in terms of a 
model of the task as are the monitored displacements in 
force control, "'he reaction forces of the task of “writing* 
are far different from those of “hammering.” The pro- 
gramming of actions in such a modeled world becomes 
more complicated and systems of “task level* program- 
ming need to be developed. 

Sensor based robotics, of which force sensing is the 
most basic, implies an entirely new level of technology. 
Indeed, robot force sensors, no matter how compliant 
they may be, must be protected from accidental collisions. 
This implies other sensors to monitor task execution and 
again the use of a world model. This new level of technol- 
ogy is the“task level," in which task actions are specified, 
not the actions of individual sensors and manipulators. 



6 Research Issues 

We may identify the following research issues in position 
and force control: 

• Matching individual joints to Cartesian degrees-of- 
freedom. 

• Control of the force of all the links of a manipulator 
not simply control of the force exerted at the end- 
effector. 

• The hybrid position/force control of redundant ma- 
nipulators. 

• Robust rigid manipulator, rigid environment force 
and contact control. 

• Contact transitions 

• Compliant cnd-efTcctor control of robot manipula- 
tors to provide for both position and force control. 

• Compliant manipulator control to provide for both 
position and force control. 

• Task level systems to provide for the protection of 
sensors. 

• Motion modeling. 


3 Thil wu graphically demonilrated by Dan Whitney at a con- 
ference in which he marched, arm rigidly outetretched, towards a an 
unknown wall. Without the compliance of a bent arm (to provide 
mechanical compliance) he would not have been able to react fast 
enough (regulator) to avoid hurting himself on contact 
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